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Verfahren unci Vorrichtung zur Bestimmung eines Fahrzeugzu- 

standes 



Die Erf indung betrifft ein Verfahren und eine Vorrichtung zur 
Bestimmung eines Fahrzeugzustandes und insbesondere ein Ver- 
fahren bzw. eine Vorrichtung zur Bestimmung von Fahrzeugzu- 
standen, deren Kenntnis zur Stabilisierung eines Fahrzeuges 
bei Erreichen eines Kippwinkels erforderlich sind. 

Bei moderrien Kraf tf ahrzeugen nimmt der Einfluss elektrischer 
und elektronischer Fahrsicherheitssysteme, wie beispielsweise 
ESP (Elektronisches Stabilitatsprogramm) , welches ein Schleu- 
dern eines Fahrzeugs im Rahmen fester physikalischer Grenzen 
verhindern soil, stetig zu. Da aus Kostengriinden eine Detek- 
tion kritischer Fahrzustande bzw. Bewegungszustande des Fahr- 
zeugs mit moglich wenig Sensormitteln erfolgen soil, ist man 
bestrebt, Bewegungsgrofien bzw. Bewegungszustande anhand weni- 
ger gemessener Parameter bestimmen zu konnen. 

Aus der DE 41 23 053 ist ein Verfahren zur Bestimmung wenigs- 
tens einer BewegungsgroSe eines Fahrzeugs bekannt . Dabei wird 
mit den MessgroSen einer Querbeschleunigung und eines Lenk- 
winkels an beiden Fahrzeugachsen eine Quergeschwindigkeit 
und/oder eine Giergeschwindigkeit des Fahrzeugs oder eine da- 
von abhangige BewegungsgroSe beschrieben. Zur Auswertung der 
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erfassten Messgrofien wird eine Kombination aus zwei adapti- 
ven, aquivalenten Kalman-Filterpaaren zugefiihrt, wobei dem 
einen Filterpaar eine MessgroSensumme und dem anderen Filter- 
paar eine MessgroSendif f erenz zugefiihrt wird. 

In der DE 195 15 055 ist eine Fahrstabilitats-Regelschaltung 
mit geschwindigkeitsabhangigem Wechsel des Fahrzeugmodells 
beschrieben, bei welcher ein Sollwert einer Gierwinkelge- 
schwindigkeit mit Hilfe eines Fahrzeugmodells errechnet wird. 
Urn einen moglichst genauen Wert sowohl bei sehr hohen, als 
auch bei sehr niedrigen Geschwindigkeiten mit Hilfe der Fahr- 
zeugmodellschaltung berechnen zu konnen, sind innerhalb der 
Fahrzeugmodellschaltung zumindest zwei Fahrzeugmodelle vorge- 
sehen, welchen geeignete Geschwindigkeitsbereiche zugeordnet 
sind, wobei in Abhangigkeit von dem gerade genutzten Ge- 
schwindigkeitsbereich zwischen beiden Modellen umgeschaltet 
wird. Dabei sind eine Hysterese der beiden Geschwindigkeits- 
schwellwerte, bei denen umgeschaltet wird, sowie Mittel zur 
Vermeidung von Sprtingen in dem Ausgangssignal der Fahrzeugmo- 
dellschaltung bei einer entsprechenden Umschaltung zwischen 
den Modellen beschrieben. 

Die beiden eben genannten, bekannten Verfahren bzw. Vorrich- 
tungen sind jedoch nicht geeignet, den Ubergang von einem 
ersten Fahrzeugzustand zu einem anderen Fahrzeugzustand bzw. 
Bewegungszustand des Fahrzeugs, insbesondere von einer Wank- 
bewegung in eine Kippbewegung, zu bestimmen, um so entspre- 
chende Gegenmafinahmen, beispielsweise durch einen Bremsein- 
griff zur Stabilisierung, insbesondere systemimmanent , auszu- 
f uhren . 

Die der vorliegenden Erfindung zugrunde liegende Aufgabe be- 
steht nun darin, ein Verfahren und eine Vorrichtung zur Be- 
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stimmung eines Pahrzeugzustandes, insbesondere eines Fahr- 
zeugbewegungszustandes, bereitzustellen, womit auf sichere 
und moglichst eindeutige Weise eine Kippbewegung eines Fahr- 
zeugs i dent if iziert werden kann. 

Erf indungsgemafe wird diese Aufgabe durch ein Verfahren mit 
den Merkmalen des Patentanspruchs 1 sowie durch eine Vorrich- 
tung zur Bestimmung eines Fahrzeugzustandes mit den Merkmalen 
des Patentanspruchs 12 gelost. 

DemgemaS ist vorgesehen: 

- Ein Verfahren zur Bestimmung eines Fahrzeugzustandes mit 
den Verf ahrensschritten: Abschatzen eines ersten Zu- 
stands eines Fahrzeugs mittels eines ersten Fahrzeugmo- 
dells anhand vorbestimmter Parameter; Abschatzen eines 
zweiten Zustands des Fahrzeugs mittels eines zweiten 
Fahrzeugmodells anhand der vorbestimmten Parameter; ge- 
wichtetes Umschalten von dem ersten Fahrzeugmodell auf 
das zweite Fahrzeugmodell beim Ubergang des Fahrzeugs 
von dem ersten Zustand in den zweiten Zustand in Abhan- 
gigkeit von mindestens einem abgeschatzten Parameter. 
( Patent anspruch 1) 

Eine Vorrichtung zur Bestimmung eines Fahrzeugzustandes, 
mit einer ersten Schatzeinrichtung zum Abschatzen eines 
ersten Zustands eines Fahrzeugs mittels eines ersten 
Fahrzeugmodells anhand vorbestimmter Parameter; mit ei- 
ner zweiten Schatzeinrichtung zum Abschatzen eines zwei- 
ten Zustands des Fahrzeugs mittels eines zweiten Fahr- 
zeugmodells anhand der vorbestimmten Parameter; mit ei- 
ner Umschalteinrichtung zum gewichteten Umschalten von 
dem ersten Fahrzeugmodell auf das zweite Fahrzeugmodell 
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beim Ubergang des Fahrzeugs von dem ersten Zustand in 
den zweiten Zustand in Abhangigkeit von mindestens einem 
abgeschatzten Parameter. ( Patent anspruch 12) 

Die der vorliegenden Erfindung zugrunde liegende Idee besteht 
im Wesentlichen darin, Bewegungszustande eines Fahrzeugs, 
insbesondere ein Wank- bzw. Kippwinkel, uber eine gesamte 
Wank- bzw. Kippbewegung abzuschatzen, wobei bezuglich der 
Wankbewegung sowie bezuglich der Kippbewegung jeweils unter- 
schiedliche Fahrzeugmodelle, insbesondere unterschiedliche 
Kalman-Filter , eingesetzt werden. Die von den Fahrzeugmodel- 
len geschatzten Zustande werden in Abhangigkeit des vorlie- 
genden Wank- bzw. Kippverhaltens gewichtet und uberla'gert, so 
dass der Ubergang von den Schatzungen des fur die Wankbewe- 
gung vorgesehenen Fahrzeugmodells zu den Schatzungen des fur 
die Kippbewegung vorgesehenen Fahrzeugmodells fliefeend er- 
folgt . 

Vorteilhafte Ausgestaltungen und Weiterbildungen der Erfin- 
dung sind den Unteranspruchen sowie der Beschreibung unter 
Bezugnahme auf die Zeichnung entnehmbar . 

Gemafe einer bevorzugten Weiterbildung bildet das erste Fahr- 
zeugmodell mittels eines ersten Kalman-Filters und das zweite 
Fahrzeugmodell mittels eines zweiten Kalman-Filters Bewe- 
gungszustande des Fahrzeugs nach. 

GemalS einer weiteren bevorzugten Weiterbildung steht der ers- 
te Zustand fur eine Wankbewegung des Fahrzeugs und der zweite 
Zustand fur eine Kippbewegung des Fahrzeugs, wobei eine Wank- 
bewegung eine Drehbewegung um eine Fahrzeuglangsach.se mit Bo- 
denkontakt aller Rader beschreibt und eine Kippbewegung einer 
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auf die Wankbewegung folgenden Drehbewegung mit Verlust des 
Bodenkontakts der Rader einer Spur entspricht. 

GemaS einer weiteren bevorzugten Weiterbildung wird bei dem 
gewichteten Ubergang von dem ersten Zustand auf den zweiten 
Zustand das zweite Fahrzeugmodell mit Parametern des Zustands 
des ersten Fahrzeugmodells initialisiert . 

Gemafi einer weiteren bevorzugten Weiterbildung erfolgt die 
Gewichtung bei der Umschaltung in Abhangigkeit eines ge- 
schatzten Winkels, vorzugsweise eines Wank- oder Kippwinkels 
des Fahrzeugs. Besonders vorteilhaft ist es, wenn die Gewich- 
tung bei der Umschaltung mit einem linearen Anstieg der Ge- 
wichtung des zweiten Fahrzeugmodells bei einem gleichzeitigen 
linearen Abfall der Gewichtung des ersten Fahrzeugmodells er- 
folgt. 

Gema£ einer weiteren bevorzugten Weiterbildung erfolgt die 
Umschaltung, wenn der Winkel zwischen einem ersten vorbe- 
stimmten Winkel und einem zweiten vorbestimmten Winkel liegt, 
wobei vorzugsweise der erste vorbestimmte Winkel einen Fahr- 
zeugwinkel beschreibt, bei welchem ein erstes entlastetes Rad 
einer Spur abhebt , und der zweite vorbestimmte Winkel einen 
Fahrzeugwinkel beschreibt, bei welchem ein zweites entlaste- 
tes Rad derselben Spur den Bodenkontakt verliert. 

Gemafi einer weiteren bevorzugten Weiterbildung werden bei der 
Abschatzung des ersten Zustands als St6rgr6£en eine Fahrbahn- 
langsneigung, eine Fahrbahnquerneigung, eine Fahrbahnquernei- 
gungsrate und/oder ein Fahrbahnreibwert nachgebildet und mit 
berucksichtigt . 
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Gemafi einer weiteren bevorzugte Weiterbildung werden die 
Fahrbahnlangsneigung und die Fahrbahnquerneigungsrate durch 
einen Markov- Prozess nachgebildet . Die Fahrbahnreibung wird 
vorteilhaf terweise als quasikonstante GroiSe modelliert. 

GemaS einer weiteren bevorzugten Weiterbildung werden bei Be- 
stimmung eines Kippens des Fahrzeugs als Bewegungszustand 
einzelne Radbremsen des Fahrzeugs selektiv aktiviert, urn eine 
Stabilisierung des Fahrzeugs zu erzielen. 

Gemafe einer weiteren bevorzugten Weiterbildung wird bei der 
Fahrzeugmodellierung die Fahrzeugmasse , die Lage des Fahr- 
zeugschwerpunktes, der Radstand, die Spurweite und/oder die 
Wankcharakteristik, insbesondere die Wanksteife, und/oder die 
Fahrzeugdampfung beriicksichtigt . 

GemaiS einer weiteren bevorzugten Weiterbildung werden mittels 
vora Fahrzeug bereitgestellter Bremsdrucke pro Rad sowie be- 
reitgestellter Radumdrehungszahlen Umf angskraf te einzelner 
Rader, vorzugsweise mittels eines deterministischen Luenber- 
ger-Beobachtersystems, eine Fahrzeuglangsbeschleunigung ge- 
schatzt . 

Gemafi einer weiteren bevorzugten Weiterbildung ist eine Gier- 
beschleunigungsmesseinrichtung, eine Querbeschleunigungsmess- 
einrichtung und vorzugsweise eine Langsbeschleunigungsmess- 
einrichtung und/oder eine Wankratenmesseinrichtung zum Be- 
reitstellen der vorbestimmten Parameter vorgesehen. 

Die Erfindung wird nachfolgend anhand der in den schemati- 
schen Figuren der Zeichnung angegebenen Ausf uhrungsbeispiele 
naher erlautert. Es zeigt dabei : 



6 



P804127/DE/1 



Fig. 1 ein schematisches Blockdiagramm zur Erlauterung der 
Funktionsweise einer Ausf iihrungsf orm der vorliegen- 
den Erfindung; 

Fig. 2 ein schemata is ches Gewichtungsdiagramm zur Erlaute- 
rung der Funktionsweise einer Ausf iihrungsf orm der 
vorliegenden Erfindung; 

Fig- 3 eine schematische Seitenansicht eines Kraft fahr- 
zeugs ; 

Fig. 4 eine schematische Draufsicht auf ein Kraf tf ahrzeug; 
und 

Fig. 5 eine schematische Heckansicht eines Kraf tf ahrzeugs , 
jeweils zur Erlauterung einer Ausf iihrungsf orm der 
vorliegenden Erfindung. 

In den Figuren der Zeichnung sind gleiche bzw. funktionsglei- 
che Elemente und Merkmale - sofern nichts anderes angegeben 
ist - mit denselben Bezugszeichen versehen worden. 

In Fig. 1 ist schematisch ein Blockdiagramm eines Verfahrens- 
ablaufs zur Best immung eines Fahrzeugzustandes zur Erlaute- 
rung einer bevorzugten Ausf iihrungsf orm dargestellt. Eine vor- 
zugsweise von einem Beschleunigungssensor gemessene Querbe- 
schleunigung a y in Querrichtung eines Fahrzeugs, das hei£t in 
y-Richtung, wird einer ersten Schatzeinrichtung 10 und einer 
zweiten Schatzeinrichtung 11 zugef iihrt . Ebenso wird eine er- 
mittelte Gierratenbeschleunigung *P ebenfalls einer ersten 
und zweiten Schatzeinrichtung 10, 11 zugef uhrt . In den 
Schatzeinrichtungen 10, 11 erfolgen jeweils separate Zustand- 
schatzungen anhand von einem ersten Fahrzeugmodell in der 
ersten Schatzeinrichtung 10 und einem zweiten Fahrzeugmodell 
in der zweiten Schatzeinrichtung 11. Zur Fahrzeugmodell ierung 
werden sowohl in der ersten als auch in der zweiten Schatz- 
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einrichtung 10, 11 vorzugsweise unterschiedliche Kalman- 
Filter eingesetzt. In die Fahr zeugmodel 1 i erungen mittels der 
vorzugsweise einzelnen Kalman-Filter flieSt sowohl die Masse 
des Fahrzeugs m als auch die Lage des Schwerpunktes S im 
Fahrzeug F, der Radstand des Fahrzeugs, die Spurweite vorn 
und hinten sowie die Wankcharakteristik, das hei£t insbeson- 
dere die Wanksteif igkeit und Dampfung des Fahrzeugs, mit ein. 
Mit dem ersten Fahr zeugmodel 1 wird der Zustand mittels eines 
Wankbeobachters abgeschatzt. 

Beim zweiten Fahrzeugmodell wird ein Kippbeobachter zur Ab- 
schatzung des Bewegungszustands in der zweiten Abschatzein- 
richtung 11 eingesetzt. Daraufhin erfolgt eine Gewichtung des 
Wankbeobachters 12 sowie eine davon getrennte Gewichtung des 
Kippbeobachters 13. Beide entsprechend gewichteten Bewegungs- 
zustandsabschatzungen werden dann in einer Addiereinrichtung 
S addiert zu einer Zustandsschatzung der kombinierten Beob- 
achter 14. Die Gewichtung des Wankbeobachters 12 und des 
Kippbeobachters 13 bei der Zustandsschatzung gehen exempla- 
risch aus Fig, 2 hervor. 

In Fig. 2 ist schematisch ein Gewichtungsdiagramm liber dem in 
den Abschatzeinrichtungen 10, 11 abgeschat zten Wank- bzw. 
Kippwinkel \<p\ dargestellt. Die Ordinate weist einen Faktor 
zwischen 0 und 1 als Gewichtsf aktor zur Multiplikation mit 
der entsprechenden Zustandsschatzung des Wankbeobachters oder 
Kippbeobachters, das heiSt des ersten Fahrzeugmodells oder 
des zweiten Fahrzeugmodells, auf . Gemafi Fig. 2 verlauft die 
Gewichtung des Wankbeobachters 12 mit dem Faktor 1 bis zu dem 
Winkel \<p x \ und fallt dann linear zwischen dem Winkel |^| und 
1 bis auf 0 ab. Entsprechend steigt die Gewichtung des 
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Kippbeobachters 13 von dem Wert 0 beim Winkel \<p x \ linear zum 
Wert 1 beim Winkle \<p 2 \ an. Beide Gewichtungsf unktionen 12, 13 
gemaS Fig. 2 konnen sowohl zu steigendem |<p| als auch in 



Richtung kleinerer \<p\ durchlaufen werden. Die Winkel 



9x 



bzw. 



stehen fur alternative Winkel, woraus eine weniger stei- 

ler Anstieg bzw. Abfall der Gewichtungsf unktionen 12, 13 re- 
sultiert. So ist gegebenenf alls bei einer Wank- bzw. Kippbe- 
wegung nur die linke Spur ein anderer vorbestimmter Winkel 

<p x , cp[ zu wahlen, als bei einer entsprechenden Bewegung 

iiber die rechte Spur eines Fahrzeugs. Der Winkel \<p\ ist ein 
von den Beobachtersystemen geschatzter Wank- bzw. Kippwinkel, 
wobei \q>\ fur einen Winkel steht, bei welchem ein Rad einer 
Spur den Bodenkontakt verliert und bei |<p 2 | beide Rader einer 
Spur keinen Bodenkontakt mehr aufweisen. 

Zur Stabilisierung einer Kippbewegung von Fahrzeugen F mit 
hoher Schwerpunktlage kann durch gezielte Bremseingrif f e an 
einzelnen Radern R eines solchen Fahrzeugs F wie beispiels- 
weise eines Dastkraf twagens oder eines Transporters ein Roll- 
Over bzw. Umkippen oder Uberschlagen dieser Fahrzeuge inner- 
halb vorbestimmter physikalischer Grenzen verhindert werden. 
Damit ein solches Reglerkonzept effektiv arbeiten kann, ist 
es erf orderlich, dass diesem System verschiedene Fahrzeugzu- 
stande zur Analyse zur Verfugung gestellt werden. Solche Zu- 
stande konnen jedoch nur teilweise direkt durch vorhandene 
Sensoren erfasst bzw. gemessen werden. Deshalb ist es gebo- 
ten, die dariiber hinaus benotigten Zustande des Fahrzeugs 



9 



P804127/DE/1 



mittels eines Beobachterverf ahrens abzuschatzen. Als Basis - 
gleichung verschiedener Beobachterverf ahren gilt : 

i = /(x,«)+^(x,«)-(y-j>) (1 
y = h(x,u) 

Der Unterschied zwischen verschiedenen Beobachterverf ahren 
besteht in der Berechnung der Riickkopplungsmatrix K(x,u), wo- 
bei gema£ der vorliegenden bevorzugten Ausf uhrungsf orm ein 
Kalman- Filter eingesetzt wird, das zur Berechnung der Ruck- 
kopplungsmatrix K(x,u) die stochastischen Eigenschaf ten des 
Systems berucksichtigt . Zur Stabilisierung eines Fahrzeugs 
bei einem auftretenden Kippwinkel <p wird allgemein die 
Kenntnis der folgenden Fahrzeugzustande vorausgesetzt : Ge- 
schwindigkeit in Fahrzeuglangsrichtung v x , Geschwindigkeit in 
Fahrzeugquerrichtung v y der Wank- bzw. Kippwinkel q> , sowie 
die Wank- bzw. Kipprate (p. Unter Wankbewegung wird im fol- 
genden eine Drehbewegung um eine Fahrzeuglangsachse , das 
heiSt x-Achse, verstanden, welche durch eine Einfederung ei- 
nes Fahrzeugs F auf einer Spurseite entsteht. Bei einer Wank- 
bewegung weisen alle Rader R Bodenkontakt auf. 1st eine Spur 
des Fahrzeugs vom Boden abgehoben, so wird die Drehbewegung 
um die Fahrzeuglangsachse im nachstehenden als Kippbewegung 
bzw. Kippen bezeichnet . 

Um die oben genannten, erf orderlichen Fahrzeugzustande uber 
die gesamte Wank- und Kippbewegung eines Fahrzeugs beobachten 
zu konnen, werden gemaS einer bevorzugten Ausf uhrungsf orm 
zwei verschiedene Kalman-Filter zur Fahrzeugmodellierung ein- 
gesetzt. Dabei ubernimmt das erste Kalman-Filter die Schat- 
zung der Fahrzustande wahrend der Wankbewegung, wohingegen 
das zweite Kalman-Filter die Zustande wahrend der Kippbewe- 
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gung zur Fahrzeugmodellierung abschatzt. Grundsatzlich ist 
die Schatzung der benotigten Fahrzeugzustande bei Nutzung ei- 
nes geeigneten Modells daruber hinaus auch mit einem einzel- 
nen Kalman-Filter moglich. Die Basis fur die zur Schatzung 
der Wankbewegung eingesetzten Filtereinrichtung bilden die 
folgenden Bewegungsgleichungen der horizontalen Geschwindig- 
keiten: 



v = + a 



(2) 



Eine Geschwindigkeitsanderung v x in y-Richtung entspricht so- 
mit dem negativen Produkt aus einer Gierwinkelgeschwindigkeit 
4* und einer Fahrzeuglangsgeschwindigkeit v x in Addition mit 
einer Beschleunigung a y in y-Richtung. Aufierdem gleicht eine 
Geschwindigkeitsanderung v x in x-Richtung dem Produkt aus der 
Gierwinkelgeschwindigkeit W und der Fahrzeuggeschwindigkeit 
v y in Querrichtung plus einer Beschleunigung a x in Langsrich- 
tung. Nutzt man innerhalb dieser beiden Gleichungen die mit- 
tels Sensoren gemessenen horizontalen Beschleunigungen a y , 
a x als Eingangssignale, so ergeben sich nach einer Transfor- 
mation aus einem f ahrzeugf esten in ein f ahrbahnf estes Koordi- 
natensystem bzw. Bezugssystem folgende linearisierte System- 
gleichungen fur das Wankfilter: 

Im Vergleich zum Gleichungssystem (2) kommt fur den Term in 
Fahrzeuglangsrichtung das Produkt aus der Erdbeschleunigung g 
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mit der Summe aus einem Fahrzeugnickwinkel 9 und einer Fahr- 
bahnsteigung © hinzu. Bei der Bewegungsgleichung in y- Rich- 
tung ergibt sich ein subtraktiver Zusatzterm als Produkt aus 
der Erdbeschleunigung g mit der Summe aus dem Wankwinkel (p 
gemessen uber der Fahrbahn plus der Fahrbahnquerneigung 4> . 
Als weitere Basisgleichung dient eine Dif f erenzialgleichung 
der Wankdynamik, welche bei kleinen Wankwinkeln gilt und aus 
dem Drallsatz urn die Fahrzeuglangsach.se resultiert : 

~_ *hAF Sv +F sh +m{a z +g)(p)+M w ( 
If 

J xx 

wobei (p fur die Wankwinkelbeschleunigung A hs fur eine Schwer- 
punktverlagerung, F Sv fur die vordere Seitenkraft der Rader, 
F sh fur die Seitenkraft der Rader R der Hinterachse A h , m fur 
die Fahr zeugmas se, a z fiir die Beschleunigung in Z-Richtung, 
welches der Hochachse im Fahrzeug F entspricht, M w einem 
Wankmoment und Jxx einem Tragheitsmoment urn die Fahrzeug- 
langsachse entspricht. Lasst man bei dieser Gleichung das 
Wankmoment M w einflieJSen mit: 

M w ^-c^-cp-dy'V ( 

wobei Ctp und d<p vorbestimmte vorzugsweise konstante Grofien 
darstellen. Druckt man die Seitenkrafte der Rader F Sv/ F sh 
durch die Querbeschleunigung aus entsprechend: 
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so ergibt sich die linearisierte Systemgleichung fur die 
Wankdynamik innerhalb des Fahrzeugmodells , vorzugsweise in- 
nerhalb des Kalman-Filters , zu: 

J xx J XX J XX 

wobei der Term w^(t) fur einen von der Zeit abhangigen Stor- 
groSenterm steht, entsprechend einem stochastischen Rauschen. 
Als Storgrofcen werden des weiteren die Fahrbahnlangsneigung 
0 , die Fahrbahnquerneigung O , die Fahrbahnquerneigungsrate 
<j> sowie der Fahrbahnreibwert ju modelliert. Vorzugsweise 
werden dabei die Fahrbahnlangsneigung © und die Fahrbahn- 
querneigungsrate <b durch einen Markov- Prozess entsprechend 
einem farbigen Rauschen nachgebildet , welches auf ein weifies 
Rauschen zuruckgef iihrt wird, da es sich bei diesen beiden 
GroSen urn stochastische, korrelierte GroSen handelt. Der 
Fahrbahnreibwert ju wird insbesondere als quasikonstante Gro- 
iSe modelliert. 

Aus den Figuren 3, 4, 5a und 5b werden schematisch die Rich- 
tungen bzw. Winkel der verschiedenen Gro£en illustriert. In 
Fig. 3 ist eine Fahrzeuggeschwindigkeit v x in Fahrzeuglangs- 
richtung dargestellt, welche exemplarisch am Fahrzeugschwer- 
punkt S angreift, auf welchen die Gewichtskraf t m-g radial 
zum Erdmittelpunkt wirkt . Der Fahrzeugbewegung in v x -Richtung 
wirkt eine Reif enreibungskraf t entgegen, welche exemplarisch 
durch den Fahrbahnreibwert /x veranschaulicht ist. Eine mog- 
liche Fahrbahnlangsneigung mit dem Neigungswinkel © geht e- 
benfalls aus der schematischen Seitenansicht gemaS Fig. 3 
hervor. In der schematischen Draufsicht nach Fig. 4 ist wie- 
derum die Fahrzeuggeschwindigkeit v x in Fahrzeuglangsrichtung 
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sowie je eine Geschwindigkeit v y in Fahrzeugquer richtung dar- 
gestellt. Daruber hinaus ist am Schwerpunkt S angreifend eine 
Gierrate *P sowie eine Gierratenbeschleunigung * beispiel- 
haft verdeutlicht. Fig. 5a und 5b verdeutlicht den Fahrzeug- 
neigungswinkel (p sowie die Neigungswinkelrate <p und Nei- 
gungswinkelbeschleunigung ip sowie nochmals die Fahrzeugquer- 
geschwindigkeit v y mit einer entsprechend in die entgegenge- 
setzte Richtung dargestellten Reibungskraf t , welche abhangig 
von dem Fahrbahnreibwert n auf die Fahrzeugrader R wirkt . 
Das Fahrzeug F ist auf der Fahrbahn B gemaS Fig. 5a in hori- 
zontaler Richtung ausgerichtet , wobei die Fahrbahn B auch ei- 
nen Fahrbahnquerneigungswinkel <1> aufweisen kann. 

Die Messgleichungen des fur die Wankbewegung zustandigen 
Fahrzeugmodells bzw. Kalman-Filters gehen aus der Anwendung 
des Impulssatzes und des Drallsatzes hervor und lauten ent- 
sprechend : 



a s ™° r ={F Sv +F sh )lm + g<p + v ay 

a*;™' = (F Uv +F Uh )/m-g0 + v ax ( a ) 

= {l v F Sv -l h F Sh +M B )/J ZZ + 

wobei v , v sowie v. einem Messrauschen der entsprechend 

_ „ _ sensor „ sensor „_...! — \4j sensor 

mit einem Sensor gemessenen GroSen a y , a x sowie f 
entspricht. Den Seitenkraf ten F Sv und F S h der Reifen in Quer- 
richtung, das heiSt in y-Richtung, entspricht eine Umfangs- 
kraft F uv und F^ der Reifen in Fahrzeuglangsrichtung, das 
heiSt in x-Richtung. In die Gierbeschleunigung <V sensor fliefien 
die Seitenkraf te Fsv sowie F S h jeweils multipliziert mit dem 
Abstand l v sowie l h zwischen dem Schwerpunkt S und der vorde- 
ren Fahrzeugachse A v sowie der hinteren Fahrzeugachse A h ge- 
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ma£ Fig. 3 ein. Das Drehmoment M B entspricht einem den Um- 
fangskraf ten F Uv ,h mit Radius zum Schwerpunkt S wirkenden 
Drehmoment. J Z z verdeutlicht ein Tragheitsmoment in z- 
Richtung, das heiSt urn die Hochachse des Fahrzeugs P. Die 
Gierbeschleunigung ^ sensor kann dabei aus der Gierrate VP zum 
Beispiel mittels eines DTi-Filters ermittelt werden. 

Geht das Fahrzeug F von der Wankbewegung in die Kippbewegung 
gemafi Fig. 5b uber, so wird die Schatzung der Zustande gemaS 
Fig. 1 und 2 auf das zweite Fahrzeugmodell , insbesondere das 
zweite Kalman-Filter , ubertragen. Zur Verkurzung der Ein- 
schwingphase dieses zweiten Filters wird er mit den bis dato 
geschatzten Zustanden des fur die Wankbewegung zustandigen 
ersten Filters initialisiert . Der Ubergang von den Schatzun- 
gen des fur die Wankbewegung zustandigen ersten Filters auf 
die Schatzungen des fur die Kippbewegung zustandigen zweiten 
Filters erfolgt mittels einer gewichteten Filterumschaltung 
gema£ Fig. 2. Innerhalb dieser Umschaltung werden die von 
beiden Fahrzeugmodellen bzw. Kalman-Filtern geschatzten Zu- 
stande in Abhangigkeit des Wank- bzw. Kippwinkels \<p\ gewich- 
tet und anschlielSend in der Additionseinrichtung 2 gemafi 
Fig. 1 addiert. Die Gewichtsf unktion gemafi Fig. 2 lautet da- 
bei : 



X — Y 



(l-s)+x lij , p -s 



(9) 



mit 



s - < 



(<P-<Pi) 



1 



>M<M 



(9) 



Hierbei liegen die beiden Winkel <p } , <p 2 den Bereich fest, in 
dem die gewichtete Umschaltung vollzogen wird (siehe Fig. 2) . 
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<p } ist der Winkel des Fahrzeugs F, bei dern das erste Rad R 
der entlasteten Spur abhebt, der Winkel q> 1 kennzeichnet den 
Winkel, bei dem auch das zweite Rad R dieser Spur den Boden- 
kontakt verliert. Innerhalb dieses Bereiches zwischen <p x und 
<p 2 besteht keine eindeutige Zuordnung, wohingegen aufierhalb 
dieses Bereichs eine eindeutige Zuordnung zu einem der beiden 
Fahrzeugmodelle, vorzugsweise Kalman-Filter , besteht. Durch 
dieses gleichmateige Uberblenden der Zustande von einem auf 
das andere Fahrzeugmodell bzw. Filter, kann ein sprungfreier 
stetiger Ubergang der Zustandsschat zung erreicht werden. 

Die Basis fur die Systemgleichung des fur die Kippbewegung 
zustandigen Fahrzeugmodell s , vorzugsweise Kalman-Filters , 
bilden ebenfalls der Impuls- und der Drallsatz. Beachtenswert 
dabei ist, dass sich die Systemgleichung im Gegensatz zu dem 
fur die Wankbewegung zustandigen Fahrzeugmodell bzw. Filter, 
fur die Kippbewegung uber die linke und die rechte Seite des 
Fahrzeugs F unterscheiden . Auch innerhalb der Systemgleichung 
des fur die Kippbewegung zustandigen zweiten Fahrzeugmodells 
bzw. Filters werden hochgradig nicht lineare Reifenkrafte 
durch Werte von Beschleunigungssensoren ersetzt. Verallgemei- 
nert geschrieben ergeben sich die Systemgleichungen dieses 
zweiten Kalman-Filters zu: 



a =v x = ^ = ^^' v y +a *»r +g& + w (10) 
dt cos<p v 
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wobei die Terrae w ^ , w vx und eine Rauschkomponente der 
entsprechenden Zustande wiedergibt und #,5, A Ist-GroSen dar- 
stellen. Die Systemgleichung der einzelnen StorgroSen Wyy , 
w m , entsprechen denen des fur die Wankbewegung zustandi- 

gen Fahrzeugmodells bzw. Kalman- Fi Iters . Die Fahrbahnquernei- 
gung O und Fahrbahnquerneigungsrate 6 konnen mit diesem 
Filter jedoch nicht geschatzt werden, da bei kippendem Fahr- 
zeug F keinerlei Unterschied zwischen den Auswirkungen der 
Fahrbahnquerneigung und dem Kippwinkel bestehen. Diese beiden 
Storgrofien sind somit nicht beobachtbar. Auch innerhalb die- 
ses Filters werden die aus den Reif enkennlinien stammenden 
Nicht -Lineari tat en in die Messgleichung uberf iihrt . Die ver- 
allgemeinerten Messgleichungen des fur die Kippbewegung zu- 
standigen zweiten Filters ergeben sich aus dem Impuls- und 
Drallsatz zu: 



ml 



a 



sensor . i-n 

y 



n{<p) 



Vsenor = — rT^Ty— T~ S (<P> ^sensor > 9> F Bx,i > M ) + V * 

J w sm 2 <p + J„ cos (p 

<P 'sensor =<P + V p 



wobei G Q einen statischen Nickwinkelanteil und der Term 

^¥-cr einen Erdbeschleunigungsanteil sowie M ^ ein Riick- 

stellmoment wiedergibt. Alle GroSen sind hier auf ein hori- 
zontales Koordinatensystem umgerechnet, woraus die sin(p,cos<p 
Anteile folgern. Anstatt die Gierbeschleunigung sensor als 
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MessgroSe zu verwenden, kann die Gierrate W sowohl als Zu- 
standsgrofie als auch als MessgroSe definiert werden. Dadurch 
werden zwar die Filtergleichungen des Wankbeobachters, das 
heiJSt des erst en Fahrzeugmodells bzw. Kalman-Filters, nicht- 
linear, allerdings kann somit die Sensoreigenschaf t , insbe- 
sondere das Messrauschen, im Filter genauer berucksichtigt 
werden. 

Unter Nutzung der von einem vorzugsweise vorhandenen ESP- 
System (Elektronisches Stabilitatsprogramm) bereitgestellten 
Bremsdrucke pro Rad, sowie der Kenntnis der Umdrehungsge- 
schwindigkeiten der einzelnen Rader R, lassen sich die Um- 
f angskraf te F vh , v der einzelnen Rader R des Fahrzeugs F schat- 
zen. Dies geschieht vorzugsweise mittels eines deterministi- 
schen Luenberger-Beobachters . Dessen geschatzte Umf angskraf te 
Fu konnen innerhalb der beiden Fahrzeugmodelle bzw. Kalman- 
Filter prinzipiell dazu genutzt werden, den Langsbeschleuni- 
gungssensor zur Messung der Beschleunigung in x-Richtung, das 
heiSt a s x ensor zu ersetzen. Aufierdem konnen mit Hilfe der ge- 
schatzten Umf angskraf te Fu vier zusatzliche Messgleichungen 
innerhalb der Kalman-Filter eingefiihrt werden. Dariiber hinaus 
werden die Normalkrafte der einzelnen Rader R des Fahrzeugs F 
mittels eines statischen Modells oder mittels eines dynami- 
schen Modells berechnet . Diese berechneten Normalkrafte wer- 
den fur das innerhalb der beiden Kalman-Filter genutzte Rei- 
fenmodell benotigt. 

Mit Hilfe der vorliegenden Erfindung kann somit auf einen Be- 
wegungszustand, insbesondere ein Wanken bzw. Kippen eines 
Fahrzeugs anhand einer Beschleunigungsinf ormation einer Be- 
schleunigung in y-Richtung a y einer Gierwinkelbeschleunigung 
T sowie gegebenenfalls einem Beschleunigungswert in x- 
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Richtung a x auf den Fahrzeugzustand, insbesondere den Wank- 
bzw. Kippwinkel <p geschlossen werden. Bei der Modellierung 
eines Lastkraf twagens , bei welchem durch die Beladung eine 
erhebliche Schwerpunktverschiebung erfolgt ist daruber hinaus 
die Wankrate <p zur Nachbildung der Fahrzeugzustande erfor- 
derlich. 

Obwohl die vorliegende Erfindung vorstehend anhand bevorzug- 
ter Ausfuhrungsbei spiel e beschrieben wurde, ist sie darauf 
nicht beschrankt, sondern auf vielfaltige Weise modifizier- 
bar. So ist grundsatzlich auch eine andere Gewichtung als die 
mit Bezug auf Fig. 2 dargestellte lineare Gewichtung der ent- 
sprechenden Fahrzeugmodelle beim Ubergang denkbar. Theore- 
tisch kann die Fahrzeugmodellierung auch tnittels eines einzi- 
gen Kalman-Filters bereitgestellt werden, dessen Parameter 
entsprechend zur Fahrzeugmodellierung angepasst werden. 
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18.12.2003 



Patentanspruche 



1. Verfahren zur Bestimmung eines Fahrzeugzustandes mit den 
Verf ahrensschritten : 

Abschatzen eines ersten Zustands eines Fahrzeugs (F) mit- 
tels eines ersten Fahrzeugmodells anhand vorbestimmter 
Parameter ( a y ,a x ) ; 

Abschatzen eines zweiten Zustands des Fahrzeugs (F) mit- 
tels eines zweiten Fahrzeugmodells anhand der vorbestimm- 
ten Parameter ( x i , , x ¥,a y ,a x ) ; 

gewichtetes Umschalten von dem ersten Fahrzeugmodell auf 
das zweite Fahrzeugmodell beim TJbergang des Fahrzeugs (F) 
von dem ersten Zustand in den zweiten Zustand in Abhan- 
gigkeit von mindestens einem abgeschatzten Parameter 
(<p) ■ 

2 . Verf ahren nach Anspruch 1 , 
dadurch gekennzeichnet , 

dass das erste Fahrzeugmodell mittels eines ersten Kal- 
man-Filters und das zweite Fahrzeugmodell mittels eines 
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zweiten Kalman-Filters Bewegungszustande des Fahrzeugs 
(F) nachbildet. 

3 . Verf ahren nach Anspruch 1 oder 2 , 
dadurch gekennzeichnet, 

dass der erste Zustand fur eine Wankbewegung des Fahr- 
zeugs (F) und der zweite Zustand fur eine Kippbewegung 
des Fahrzeugs (F) steht, wobei eine Wankbewegung eine 
Drehbewegung urn eine Fahrzeuglangsachse mit Bodenkontakt 
aller Rader beschreibt und wobei eine Kippbewegung einer 
auf die Wankbewegung folgenden Drehbewegung mit Verlust 
des Bodenkontakts zumindest der Rader (R) einer Spur ent- 
spricht . 

4. Verf ahren nach einem der vorangehenden Anspruche, 
dadurch gekennzeichnet, 

dass bei dem gewichteten Umschalten von dem ersten Zu- 
stand auf den zweiten Zustand das zweite Fahrzeugmodell 
mit Parametern (¥^ 9 a y ,a x ) des Zustands des ersten Fahr- 
zeugmodells initialisiert wird. 

5. Verf ahren nach einem der vorangehenden Anspruche, 
dadurch gekennzeichnet , 

dass die Gewichtung bei dem gewichteten Umschalten in Ab 
hangigkeit eines geschatzten Winkels (cp) , vorzugsweise 
eines Wank- oder Kippwinkels des Fahrzeugs (F) , insbeson 
dere mit einem linearen Anstieg der Gewichtung des zwei- 
ten Fahrzeugmodells bei einem gleichzeitigen linearen Ab 
fall der Gewichtung des ersten Fahrzeugmodells, erfolgt. 

6. Verf ahren nach Anspruch 5, 
dadurch gekennzeichnet, 
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dass die Umschaltung dann erfolgt, wenn der Winkel {<p) 
zwischen einem ersten vorbestimmten Winkel ( (p x ) und einem 
zweiten vorbestimmten Winkel (<p 2 ) liegt, wobei vorzugs- 
weise der erste vorbestimmte Winkel (<?>,) einen Fahrzeug- 
winkel beschreibt, bei welchem ein erstes entlastetes Rad 
(R) einer Spur abhebt, und der zweite vorbestimmte Winkel 
((p 2 ) einen Fahrzeugwinkel beschreibt, bei welchem ein 
zweites entlastetes Rad (R) derselben Spur den Bodenkon- 
takt verliert . 

7. Verfahren nach einem der vorangehenden Anspruche, 
dadurch gekennzeichnet , 

dass bei der Abschatzung des ersten Zustands als Storgro- 
Gen eine Fahrbahnl angsne igung (0), eine Fahrbahnquernei- 
gung ( <D ) , eine Fahrbahnquerneigungsrate ( 6 ) und/oder 
ein Fahrbahnreibwert (m) nachgebildet und beriicksichtigt 
werden . 

8. Verfahren nach Anspruch 7, 
dadurch gekennzeichnet, 

dass die Fahrbahnl angsneigung (©) und die Fahrbahnquer- 
neigungsrate (4>) durch einen Markov-Prozess nachgebildet 
und die Fahrbahnreibung (aO als quasikonstante GroBe mo- 
delliert werden. 

9. Verfahren nach einem der vorangehenden Anspruche, 
dadurch gekennzeichnet, 

dass bei Bestimmung eines Kippbewegung des Fahrzeugs (F) 
als Bewegungszustand einzelne Radbremsen des Fahrzeugs 
(F) selektiv aktiviert werden, urn eine Stabilisierung des 
Fahrzeugs (F) zu erzielen. 
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10. Verfahren nach einem der vorangehenden Anspriiche, 
dadurch gekennzeichnet, 

dass bei der Fahrzeugmodellierung die Fahrzeugmasse <m) , 
die Lage des Fahrzeugschwerpunktes (S) , der Radstand, die 
Spurweite und/oder die Wankcharakteristik, insbesondere 
die Wanksteife, und/oder die Fahrzeugdampf ung berucksich- 
tigt wird. 

11. Verfahren nach einem der vorangehenden Anspriiche, 
dadurch gekennzeichnet, 

dass mittels vom Fahrzeug (F) bereitgestellter Bremsdrii- 
cke pro Rad (R) sowie mittels bereitgestellter Radumdre- 
hungszahlen Umf angskraf te einzelner Rader (R) , vorzugs- 
weise mittels eines deterministischen Luenberger- Beob- 
achtersystems, geschatzt werden, woraus eine Fahrzeug- 
langsbeschleunigung (a x ) geschatzt wird. 

12. Vorrichtung zur Bestimmung eines Fahrzeugzustandes , ins- 
besondere zum Betreiben eines Verfahrens nach einem der 
vorangehenden Anspriiche, mit : 

einer ersten Schatzeinrichtung zum Abschatzen eines ers- 
ten Zustands eines Fahrzeugs (F) mittels eines ersten 
Fahrzeugmodells anhand vorbestimmter Parameter 

einer zweiten Schatzeinrichtung zum Abschatzen eines 
zweiten Zustands des Fahrzeugs (F) mittels eines zweiten 
Fahrzeugmodells anhand der vorbestimmten Parameter 
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einer Umschalteinrichtung zum gewichteten Umschalten von 
dem ersten Fahrzeugmodell auf das zweite Fahrzeugmodell 
beim Ubergang des Fahrzeugs (F) von dem ersten Zustand in 
den zweiten Zustand in Abhangigkeit von mindestens einem 
abgeschatzten Parameter ( <p ) . 

13 . Vorrichtung nach Anspruch 12 , 
dadurch gekennzeichnet , 

dass eine Gierbeschleunigungsmesseinrichtung, eine Quer- 
beschleunigungsmesseinrichtung und vorzugsweise eine 
Langsbeschleunigungsmesseinrichtung und/oder eine Wankra- 
tenmesseinrichtung zum Bereitstellen der vorbestimmten 
Parameter vorgesehen ist. 
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Zus ammenf as sung 



Die vorliegende Erfindung stellt ein Verfahren zur Bestimmung 
eines Fahrzeugzustandes mit den Schritten bereit : Abschatzen 
eines ersten Zustands eines Fahrzeugs (F) mittels eines ers- 
ten Fahrzeugmodells anhand vorbestimmter Parameter 
( x ¥^,a v9 a r ) ; Abschatzen eines zweiten Zustands des Fahrzeugs 
(F) mittels eines zweiten Fahrzeugmodells anhand der vorbe- 
stimmten Parameter ( y ¥ 9 y ¥ 9 a y9 a x ) ; gewichtetes Umschalten von 
dem ersten Fahrzeugmodell auf das zweite Fahrzeugmodell beim 
Ubergang des Fahrzeugs (F) von dem ersten Zustand in den 
zweiten Zustand in Abhangigkeit von mindestens einem abge- 
schatzten Parameter (<p). Die vorliegende Erfindung stellt 
ebenfalls eine Vorrichtung zur Bestimmung eines Zustands ei- 
nes Fahrzeugs (F) bereit. 

Fig. 1 



Wied 

18.12.2003 
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